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Verfahren zur Kalibrierung eines Sensorsystems 
Stand der Technik 

Die Erfindung betrifft ein Verfahren zur Kalibrierung 
eines Sensorsystems, insbesondere eines 
Bildverarbeitungssystems , nach der Gattiing des 
Hauptanspruchs . 

Es ist an sich bekannt, dass Bildauf nahme- und andere 
Sensorsysteme als ein Baustein eines 

Fahrzeugsicherheitssystems im Strafienverkehr angewendet 
werden. Hierbei werden standig Inf ormationen iiber den 
Abstand und die Relativgeschwindigkeit des Fahrzeuges im 
Verhaltnis zu anderen Objekten, d.h. anderen Fahrzeugen und 
zu den StraSengegebenheiten, ve.rarbeitet . Die 
Bildauf nahmesyst erne und ggf . auch Radarsensoren werden zur 
Messung geometrischer GroiSen im Fahrzeugumf eld verwendet, 
wobei die Radarsensoren fiir sich gesehen beispielsweise aus 
der DE 42 42 700 Al bekannt sind. Mit dieser bekannten 
Anordnung kann beispielsweise eine Geschwindigkeitsregelung 
im Fahrzeug derart erweitert werden, dass die 
Fahrgeschwindigkeit an langsamere vorausf ahrende Fahrzeuge 
angepasst wird, wenn diese von den Sensorsystemen im 
voraussichtlichen Kursbereich des Fahrzeugs erfasst werden. 
Der Kursbereich kann dabei beispielsweise mit Hilfe von 




Gierraten- , Lenkwinkel- , Querbeschleunigungssensoren, uber 
die Radgeschwindigkeiten, oder auch mit den erwahnten 
Bildverarbeitungs- oder mit Navigationssystemen bestimmt 
werden . 

Fur eine einwandfreie Funktion des Systems ist im Prinzip 
eine vorherige Kalibrierung des Sensorsystems oder der 
Einzelsensoren im Fahrzeugumf eld zur anschlieEenden genauen 
Messung geometrischer GroEen wie Langen, Geschwindigkeiten 
erf orderlich, die vor oder nach Einbau der Sensoren ins 
Fahrzeug in laborahnlicher Umgebung erf olgt . Die 
verschiedenen Kalibrierungsverf ahren erfordern in der Regel 
eine gezielte Bewegung der Sensoren bzw. der von der 
Sensorik erfaSten Objekte. Haufig ist sogar die Betrachtung 
eines speziellen Kunstobj ektes erf orderlich, das 
entsprechend als Kalibrierf eld bezeichnet wird. Um eine 
dauerhafte Funktionssicherheit zu gewahrleisten ist auch 
eine spatere wiederholte Kontrolle der Kalibrierung auf 
mogliche Veranderungen notwendig, die sehr aufwendig sein 
kann . 

Fiir sich gesehen ist aus der EP 0 602 013 Bl bekannt , dass 
zur Kalibrierung eines Koppelnavigationssystems 
Umgebungsinf ormationen, die beispielsweise aus einer 
StraSenkarte bekannt sind, herangezogen werden. Hierbei 
werden Inf ormationen liber den eigenen Fahrzeugzustand in 
Verbindung mit den aus der Karte bekannten 
Umgebungsinf ormationen verarbeitet . 

Vorteile der Erfindung 

Ein Verf ahren zur Kalibrierung eines Sensorsystems, mit dem 
eine Erfassung und Auswertung von Objekten im Kursverlauf 
eines Fahrzeuges durchgefuhrt wird, ist erf indungsgemaS so 
aufgebaut, dass mit dem Sensorsystem in vorteilhaf ter Weise 
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charakteristische Daten der Objekte, einschlieSlich der 
Fahrbahn, erfasst warden und die Daten, die unter 
Beriicksichtigung der Eigenbewegxing des Fahrzeugs als ruhende 
Oder quasi ruhende Objekte erkannt werden, einer 
Kalibrierungseinheit zugefiihrt werden. In dieser 
Kalibrierungseinheit werden die Abweichung der aktuell 
gemessenen Daten von Daten eines Modells der Objekte als 
Fehlervektor ermittelt und zur Korrektur der Daten des 
Modells in Richtung auf eine Minimierung der Abweichung, 
2.B. mit einem iterativen Verfahren, herangezogen. 

Mit der Erfindung kann in besonders vorteilhaf ter Weise eine 
automatische Kalibrierung eines eingangs beschriebenen 
Sensorsystems und daruber hinaus eine spatere automatische 
Uberpriifung einer einmal gewonnenen Kalibrierung . 
durchgefiihrt werden. Hierzu sind auSer der an sich bekannten 
Sensorelemente in der Fahrzeugumgebung und einer Auswerte- 
bzw. Kalibrierungseinheit keine weiteren Hilfsmittel 
erf orderlich . 

Auch speziell durchgef uhrte Bewegungen des Fahrzeugs, die 
bislang eigens zum Zweck der Kalibrierung durchzuf ahren 
waren, sind verzichtbar, da die erf indungsgemaSe 
Kalibrierung vielmehr die Eigenbewegung der Fahrzeuge im 
Betrieb sowie das Wissen nutzt, dalS Objekte der 
drei dimensional en Welt haufig starr sind, bzw. sich 
ganzheitlich bewegen und die Kalibrierung der Sensoren uber 
einen langeren Zeitraum stabil ist. Hierbei ist die 
Kalibrierung der Sensorik quasistationar , d.h. allenfalls 
langsam veranderlich . Auch heuristische Annahmen uber 
typisches Verhalten anderer Verkehrsteilnehmer (z.B. 
Spurhalten) , die in praktischen Anwendungen zu 
Fehlf unktionen fiihren konnen, sind fur dieses Verfahren 
nicht erf orderlich. Eine wesentliche Eigenschaft der 
Erfindung ist somit, dass eine Kalibrierung moglich wird, 
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welche die messbaren GrdSen moglichst gut erf asst . Die 
Forderiing nach einer sog . wahren Kalibrierung, wie sie bei 
Laborkalibrierungen gestellt wird, ist hier nur zweitrangig. 

Fertigungstechnisch ist daruber hinaus der Einbau 
unkalibrierter Sensoren besonders vorteilhaft, da die 
Kalibrierung eines Sensors oftmals empfindlich gegen 
mechanische oder thermische Beanspruchung ist. Somit ist 
nicht nur die Fertigung vereinfacht, sondern es ist auch 
eine spatere Beriicksichtigung von Einflussen des Einbaus 
Oder von anderen Veranderungen der Sensorik, bzw. des 
Fahrzeugs, auf die Kalibrieriing auf einfache Weise 
durchf uhrbar . Daruber hinaus kann die Kalibrierung auch 
jederzeit liberpruft werden. 

Nach einer besonders vorteilhaf ten Ausfiihrung des 
erf indungsgemaSen Verfahrens wird in einer 

Initialisierungsphase mit vorgebbaren Parametern eine erste 
Erfassung der Objektdaten vorgenommen, die als Modelldaten 
gespeichert werden. In alien zyklisch darauf folgenden 
Messungen werden die jeweils aktuellen Objektdaten mit den 
zuvor erfassten gespeichert en Modelldaten zur Gewinnung des 
jeweiligen Fehlervektors in der Kalibrierungseinhei t 
verarbeitet . 

Wahrend der Verarbeitung der Daten in der 

Kalibrierungseinheit werden die jeweils aus den vorherigen 
Messungen wiederkehrenden Objektdaten ausgewahlt, wobei 
nicht wieder gefundene Objektdaten geloscht sowie jeweils 
neu hinzugekommene Objektdaten aufgenommen werden. Die 
Objektdaten, die nach mehrmaligen Messungen aus 
unterschiedlichen Positionen des Fahrzeugs heraus eine 
Verkleinerung des jeweiligen Konf idenzintervalls aufweisen, 
werden als zu einem ruhenden oder quasi ruhenden Objekt 
gehorenden Daten gekennzeichnet . 
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Bei dem erf indiingsgemaSen Verfahren kann dariiber hinaus auch 
aus auf einanderf olgenden Objektdaten eine ubereinstimmende 
Relativgeschwindigkeit von Objekten und daraus auch die 
Eigenbewegung des Fahrzeugs ermittelt werden. Die 
Objektdaten, die einem Objekt mit dieser gleichen 
Relativgeschwindigkeit zuzuordnen sind, konnen dabei als zu 
einem ruhenden oder quasi ruhenden Objekt gehorenden Daten 
gekennzeichnet werden. In vorteilhaf ter Weise kann als 
Eigenbewegung des Fahrzeugs z.B, auch eine Rotat ionsbewegung 
des Fahrzeuges durch Nickbewegungen und/oder durch 
Kurvenf ahrten herangezogen werden. 

Die Ergebnisse der Kalibrierung eines Sensors des 
Sensorsystems konnen auf einfache Weise auf einen oder 
mehrere weitere Sensoren am Kraft fahrzeug zur Kalibrierung 
auch dieser Sensoren ubertragen werden. Mit dem 
erf indungsgemaSen Verfahren ist somit eine gemeinsame . 
Kalibrierung der meisten Fahrzeugsensoren nach dem Einbau 
moglich, ohne spezielle Randbedingungen zu erfordern. 
Insbesondere die Kombination von Sensoren, wie Kamera, 
Radar, Radsensor, Beschl'eunigungssensor ist hier 
vorteilhaf t; aber auch eine Anwendung in Zusammenhang mit 
Lidar- oder Ultraschallsensoren ist moglich. 

Fur den Fall, dass der oder die Sensoren des Sensorsystems 
widerspriichliche Messdaten erstellen, kann beispielsweise 
eine Signal isierung an eine Auswerteeinheit oder an den 
Fahrer des Fahrzeugs erfolgen. 

Die Erfindung dient somit in vorteilhaf ter Weise der 
Durchfiihrung einer Kalibrierung mit gutem Ergebnis ohne eine 
spezielle Kalibrieranordnung oder Kalibrierbewegungsf olge zu 
erfordern. Das Sensor- bzw. Auswertesystem kann sich hierbei 
vollstandig oder weitgehend selbsttatig kalibrieren und die 
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Genauigkeit und Zuverlassigkeit seiner Kalibrieriing 
bestimmen. Parameter, die nicht oder noch nicht kalibriert 
sind, sind durch eine iinendliche Ungenauigkeit 
gekennzeichnet . Insbesondere bemerkt das vorgestellte 
erf indungsgemaSe Verfahren grobe Veranderungen der 
Kalibriemng, die z.B. aufgrund thertnischer oder 
mechanischer Verschiebungen moglich sind. 

Besonders vorteilhaft kann die Erfindung angewendet werden, 
wenn das Sensorsystem ein Bildaufnahme system ist, bei dem 
mittels einer elektronischen Kamera mit nichtlinearer 
Wandlerkennlinie in den Auf nahmeintervallen jeweils seriell 
Bildpunkte erfasst und ausgewertet werden. Viele 
herkommliche Bildauf nahmeverf ahren fiihren die 
Kamerakalibrierung uber den Umweg der sog. 
Fundamentalmatrizen aus und sind deshalb auf eine 
zeitgleiche Aufnahme der Bildelemente (kubisches Bildraster) 
und synchrone Sensordaten angewiesen. Das erf indungsgemaSe 
Verfahren arbeitet hingegen auch mit einem beliebigen 
Aufnahmezeitpunkt der einzelnen Bildpunkte und mit 
asynchronen Sensordaten. Somit ermoglicht das Verfahren 
insbesondere die Kalibrierung von hochauf losenden 
Videokameras mit nichtlinearer Kennlinie, welche in der 
Regel ihre Bildpxinkte seriell aufnehmen. 

Diese .und weitere Merkmale von bevorzugten Weiterbildungen 
der Erfindung gehen auSer aus den Anspriichen auch aus der 
Beschreibung und den Zeichnungen hervor, wobei die einzelnen 
Merkmale jeweils fur sich allein oder zu mehreren in Form 
von Unterkombinationen bei der Aus fuhrungs form der Erfindung 
und auf anderen Gebieten verwirklicht sein und vorteilhafte 
sowie fur sich schutzfahige Ausfiihrungen darstellen konnen, 
fur die hier Schutz beansprucht wird. 
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Zeichnung 

Das erf indungsgemaSe Verfahren zur Kalibrierung eines 
Sensorsystems wird anhand eines Ausf ulirungsbeispiels bei der 
Anwendung des Verfahrens in einem Bildverarbeitungssystem, 
zur Auswertung von Objekten im Kursverlauf eines Fahrzeuges, 
in der Zeichniong erlautert . 

Es zeigen: 

Figur 1 eine Skizze eines Fahrzeugs mit einem Sensor und 
einem Auswerte- und Kalibrierungssystem fiir die Anwendung 
mit einer Vielzahl von Einzelsensoren einschlieSlich eines 
Bildauf nahmesystems ; 

Figur 2 eine erste Ablauf skizze der Kalibrierungsschritte ; 

Figur 3 eine zweite Ablaufskizze der Kalibrierungsschritte 
und 

Figur 4 eine Darstellung eines Lochkameramodells zur 
Erlauterung der theoretischen Zusammenhange bei der 
Gewinnung eines Fehlervektors im Kal ibrierungsverf ahren . 

Beschreibung des Ausf iihrungsbeispiels 

Figur 1 zeigt eine mogliche Ausgestaltung eines 
Sensorsystems zur Durchfuhrung einer Selbstkalibrierung der 
Sensorelemente, das in ein System zur Erfassung des Fahr- 
zeugumfelds in einem Fahrzeug 1, wie in der 
Beschreibungseinleitung erwahnt, integriert ist . In der 
Figur 1 sind hier nur beispielhaft als Sensoren eine 
elektronische Kamera als Bildauf nahmesensor 2, ein 
Radarsensor 3, ein Beschleunigungssensor 4 und weitere 
Radsensoren 5 dargestellt. Diese Sensoren 2 bis 5 konnen, 
wie aus der Figur 1 mit den Abstrahlf eldern undden Pfeilen 
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fur die zu erfassenden mechanischen GroSen angedeutet, auf 
die Erfassung der Bewegung des Fahrzeugs 1 und des vorderen 
Fahrzeugumf elds ausgerichtet sein. 

Bei anwendungstypischen Gegebenheiten befinden sich im 
Erf assungsbereich, bzw. im Fahrzeugumf eld Objekte 6 oder 
sogar Gruppen von Objekten 6, die sich uber einen langeren 
Betrachtungszeitraum nicht verformen, sondern sich 
allenfalls als Ganzes bewegen. Beispielhaft konnen hierfiir 
insbesondere die Fahrbahn, die Leitplanken oder unter 
Umstanden auch weitere Fahrzeuge genannt werden. Die mit 
den Sensoren 2 bis 5 gewonnenen Daten werden beim 
Ausf iihrungsbeispiel nach der Figur 1 einer oder mehreren 
Auswerteeinheiten 7 zugefiihrt, welche auch eine 
Kalibrierungeinheit beinhalten und die Inf ormationen uber 
die Fahrzeugumgebung auswerten und Kalibrierung durchfiihren. 
Die Auswerteeinheit 7 ist in der Regel ohnehin zur 
Ermittlung von Fahrzeugumf eldinformat ion vorhanden und kann 
daher zur Bestimmung der Kalibrierungsparameter mitverwendet 
werden . 

Die Auswerteeinheit 7 benotigt fur die Durchfiihrung der 
Sensorkalibrierung Objektdaten, die einem Speicher 8 
entnommen werden konnen. In der Auswerteeinheit 7 wird mit 
der Auswertung der Objektdaten die jewel Is im Speicher 8 
befindliche Kalibrierungsinf ormation in einer welter unten 
noch naher erlauterten Art und Welse verbessert. Die von 
der Auswerteeinheit 7 unter Zuhilfenahme der Kalibrierung 
berechnete Information iiber das Fahrzeugumf eld wird dann zur 
Beeinf lussung des Fahrzeugs 1 liber eine Aktorik 9 umgesetzt 
und/oder informativ an den Fahrer des Fahrzeugs 1 iiber eine 
Mensch-Maschine Schnittstelle 10, z.B. einen Lautsprecher 
Oder ein Display, weitergegeben . Die Aktorik 9 kann hierbei 
z.B. ein Stellsignal fur die Fahrzeugbremse verarbeiten. 
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Anhand Figur 2 sind mdgliche Verf ahrensschritte bei der 
Durchfuhrung der Selbstkalibriening des Sensorsystems im 
Fahrzeug 1 nach der Figur 1 veranschaulicht . Hierbei werden 
die von den Sensorelementen 2 bis 5 gemessene GroSen einer 
realen Welt, dargestellt durch die Blocke 20 und 21, 
sogenannten modellierten GroSen, dargestellt durch die 
Blocke 22 und 23, gegeniibergestellt . Die Differenz zwischen 
den gemessenen Gr6£en und den modellierten GroSen, ermittelt 
im Block 24, bildet im Block 25 einen Fehlervektor . Die 
Durchfuhrung der Kalibrierung innerhalb der Auswerteeinheit 
7 erfolgt hierbei so, dass der Fehlervektor moglichst klein 
wird, d.h. die Modellwelt der realen Welt moglichst gut 
entspricht . 

Die aus den Objektdaten der Sensoren 2 bis 5 gewonnene 
Kalibrierungsdaten bilden gemeinsam mit Modelldaten der 
parametrischen Modellwelt, entsprechend der Beschreibung des 
Fahrzeugumf eldes , auch einem Parametervektor , der in einem 
Block 26 abstrakt gezeigt ist Das Modell beinhaltet dabei 
neben der parametrischen Beschreibung der Welt auch die 
Abbildung der Welt auf durch die Sensorelemente 2 bis 5 
messbaren GroSen. Fiir das Beispiel der Anwendung einer 
Kamera als Bildauf nahmesensor 2 ist dies die Projektion der 
Welt auf die Bildfolge. Die messbaren GroSen werden dann 
sowohl aus der parametrischen Modellwelt bestimmt als auch 
durch das Sensorelement 2 gemessen.. Die Differenz dieser 
beiden Bestimmungen der messbaren GroSen wird zu einem 
Fehlervektor gruppiert (Block 25) . Der Parametervektor in 
Block 26 wird dann durch geeignete Verfahren, die in einem 
Block 27 gekennzeichnet sind, so eingestellt, dass der 
Fehlervektor minimal wird, d.h. er wird derart minimiert, 
dass die tatsachlichen Messungen und die durch das Modell in 
Verbindung mit dem aktuellen Parametervektor bestimmten 
GroSen moglichst gut libereinstimmen . 
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Fur die Durchfiihrung eines solchen, fur sich bekannten, 
Minimierungsverf ahrens ist ein einfaches Kriterium fiir eine 
gute Ubereinstimmung der Gr6£en beispielsweise die 
Quadratsumme der Abweichungen . Ein hinreichend gutes 
Ergebnis des Minimierungsverf ahrens kann beispielsweise 
durch ein sog. Least - Square -Verfahren gefunden werden oder 
es konnen auch weiterhin andere robuste Schat zverf ahren 
sowie ein sog. Extended Kalman Filter bzw. ahnliche Ansatze 
verwendet werden. Alle diese, fiir sich gesehen bekannten, 
Verfahren erlauben die Bestimmung der Genauigkeit und 
Zuverlassigkeit von Parametern und Messungen. 

Dem erf indungsgemaSen Verfahren liegt, wie oben erwahnt , die 
Annahme zugrunde, dass starre Objekte 6 oder Gruppen solcher 
Objekte 6 im Fahrzeugumf eld existieren. Ihre Bewegung laSt 
sich daher durch drei Rotationsparameter und drei 
Translationsparameter vollstandig beschreiben. Weiterhin 
wird angenommen , dass sich zumindest manche dieser Objekte 6 
relativ zum Fahrzeug 1 bewegen, beispielsweise aufgrund der 
Eigenbewegung des Fahrzeugs 1. Diese Voraussetzungen sind 
haufig genug erfullt, so dass eine Berechnung oder 
Uberpriifung der Kalibrierung in kurzen Intervallen moglich 
ist . 

Figur 3 zeigt ein weiteres mogliches FluSdiagramm zur 
Durchf.iihrung des erf indungsgemaSen Verf ahrens hinsichtlich 
der Auswertung der Objektdaten, welches im Zusammenhang mit 
einem sog. Lochkameramodell anhand Figur 4 erlautert werden 
soil. Anhand des in der Figur 3 dargestellten Flussdiagramms 
soil eine einfache Ausfiihrung der Auswertung der Objektdaten 
nachfolgend dargelegt werden. Hierbei umfasst das zugrunde 
liegende Sensorsystem notwendigerweise nur eine Kamera 
(Sensor 2) und den Radarsensor 3. Auf die nahere Erlauterung 
des Flussdiagramms nach der Figur 3 wird nach einer 
Beschreibung der Figur 4 eingegangen. 
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Die Figur 4 stellt beispielhaft ein einfaches bekanntes 
Abbildungsmodell fur den Sensor 2 als sog. Lochlcameramodell 
dar und dient dabei lediglich der Begrif f sdef inition . Die 
Kalibrierparameter der Sensoren 2 und 3 werden gemeinsam mit 
ModellgroSen der parametrischen Modellwelt als Beschreibung 
des Fahrzeugumf eldes , wie anhand der Figur 2 erlautert, in 
einem Parametervektor zusammengef afit . Das Modell nach der 
Figur 4 beinhaltet neben der parametrischen Beschreibung der 
Welt auch die Abbildung der Welt auf die mit den Sensoren 2 
und 3 messbaren Grollen. Fur das Beispiel der Kamera 2, bzw. 
der Lochkamera nach der Figur 4, ist dies die Projektion der 
Welt auf die Bildfolge. Die messbaren GroSen werden dann 
sowohl aus der parametrischen Modellwelt bestimmt als auch 
durch die Sensorik gemessen. Die Differenz dieser beiden 
Bestimmungen der messbaren GroSen wird zu einem Fehlervektor 
gruppiert. Der Parametervektor wird durch geeignete 
Verfahren so eingestellt, daS der Fehlervektor minimal wird, 
d.h. so, dass die tatsachlichen Messungen und die durch das 
Modell in Verbindung mit dem aktuellen Parametervektor 
bestimmten GroSen moglichst gut ubereinstimmen . 
In der Figur 4 beschreibt der Punkt C das Pro j ekt ions zent rum 
durch welches alle Abbil dungs strahl en des Sensors 2 
verlaufen. Die Senkrechte zur Bildebene durch das 
Pro j ekt ions zentrum C wird als optische Achse (Z-Achse) 
bezeichnet. Die Z-Achse schneidet eine Bildebene B im 
Bildhaupt punkt Pbh- Der Bildhaupt punkt Pbh hat in dem durch 
Bildzeilen und -spalten auf gespannten 
Rechnerkoordinatensystem die Koordinaten (x_r, y_r) 
entsprechend (x_h, y_h) . Die X- und Y-Achse des 
Kamerakoordinatensystems verlaufen dabei parallel zu den 
Achsen des Rechnerkoordinatensystems . Als Kammerkonstante c 
wird hier der Abstand des Projektionszentrums vom 
Bildhauptpujnkt Pbh/ dividiert durch den Abstand zwischen 
zwei Bildpunkten einer Bildspalte, bezeichnet. SchlieSlich 
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wird das Verhaltnis des Abstandes zweier Bildpunkte 
innerhalb einer Bildspalte zum Abstand innerhalb einer 
Bildzeile als Achsenverhaltnis s bezeichnet. Fiir das 
Lochkameramodell nach der Figur 4 bilden die vier genannten 
Parameter (x_h, y_h, c, s) die sog. intrinsischen Parameter 
der Kalibrierung . Damit kann die Projektion eines 
Objektpunktes Pq auf die Bildebene (Bildpunkt Pq) nach der 
folgenden Beziehung angegeben werden: 



Es wird hier weiterhin angenommen, dass fiir die Kamera 
(Sensor 2) ein einf aches Lochkameramodell nach der Figur 4 
zugrunde liegt, dessen intrinsische Kalibrierung die 
Parameter Bildhauptpunkt Pbh/ Kammerkonstante c und die 
Bildachsenskalierung umf asst . Fiir den Radarsensor 3 sollen 
zusatzlich der Verschiebungsvektor T und die Rotation R 
zwischen Radarkoordinatensys tern und Kamerakoordinatensystem 
kalibriert werden. Damit ergibt sich der Zusammenhang 
zwischen dem Kamerakoordinatensystem {X,Y,Z) und dem 
Radarkoordinatensystem (X__R, Y__R, Z_R) zu : 



Die Kalibrierungsparameter der Sensoren 2 und 3 bilden dann 
den gesuchten Kalibrierungsvektor p_k . 

Als messbare GroSen werden z.B. von der Kamera (Sensor 2) 
die Bildkoordinaten ruhender charakterist ischer Punkte an 
Objekten 6 (Ecken, o.a.) und vom Radarsensor 3 die 
Entfernung, Winkel und Relativgeschwindigkeit von ruhenden 
Objekten 6 im Radarkoordinatensystem bezeichnet. Die 
geometrischen Parameter, aus denen sich messbare GroSen mit 



X r = X h + s*c*X / Z 



y_r = y_h + c*Y / Z 



(1) 



(X,Y,Z) = R * ( (X__R, Y_R, Z_R) - T) . 



(2) 



Hilfe der Kalibrierung anhand des Abbildiingsmodells nach der 
Figur 4 bestimmen lassen, werden hier als Model Iparameter 
p_m bezeichnet. Fiir das gewahlte Beispiel sind dies die 

(Kamera-) Koordinaten der charakteristischen Punkte sowie 
die Koordinaten iind die Relativgeschwindigkeit von Objekten. 
Das Abbildungsmodell ist fiir die Kamera (Sensor 2) durch die 
Gleichung (1) und fur den Radarsensor 3 durch die Gleichung 

(2) gegeben. Die Model Iparameter p_m bilden gemeinsam mit 
den Kalibrierungsparametern p_k den Parametervektor p (vgl . 
Block 2 6 aus der Figur 2). 

Nach dem Flussdiagramm aus der Figur 3 wird zunachst der 
Parametervektor p initialisiert (Block 30), z. B. wird der 
Bildhauptpunkt PgH willkiirlich auf den Bildmittelpunkt 
gesetzt, als Kammerkonstante c und Achsenverhaltnis werden 
die groben Werte, wie sie beispielsweise der 

Kamerahersteller angibt, verwendet . Der Verschiebungsvektor 
T und der Rotationsvektor R werden grob, beispielsweise mit 
einem MetermaS, vermessen. Da bislang weder 

charakteristische Bildpunkte noch Objekte vermessen wurdeii, 
enthalt der Model Iparametervekt or p_m noch keine Parameter 
und die Menge der messbaren GroSen wird als leer 
initialisiert. 

In einem weiteren Schritt werden von den Sensoren 2 und 3 
Messungen durchgefiihrt (Block 31) , wobei insbesondere die in 
zeitlich vorhergehenden Messungen bereits ermittelten 
messbaren GrolSen in Block 32 wieder gesucht werden, sog. 
Tracking. Die aktuell bestehende Menge messbarer GroSen wird 
dann nach Block 33 um neu hinzugekommene mes share GroSen, 
wie z.B. um neu ins Bild gekommene charakteristische Punkte, 
erweitert . Die beim sogenannten Tracking nicht wieder 
gefundenen messbaren GroSen werden dabei aus der Menge der 
messbarer GroSen entfernt. 
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Fur alle messbaren Gr6£en werden die Model Iparameter p_m und 
die Fahrzeugeigenbewegung zum vorherigen MeSzeitpunkt mit 
den zugehorigen Konf idenzintervallen mittels an sich 
bekannter Standardmethoden bestimmt. Nachdem beispielsweise 
ein charakteristischer Objektpunkt Pq das erste Mai gemessen 
wurde, umfasst das Konf idenzintervall dabei noch mindestens 
eine Gerade . Nach mehrmaligem Vermessen derselben 
charakteristischen Objektpunktes Pq aus unterschiedlichen 
Positionen lassen sich die Modellparameter p_m und die 
Fahrzeugeigenbewegung zunehmend genauer vermessen, so dass 
das entsprechende Konf idenzintervall kleiner wird. 
Objektpunkte Pq mit kleinem Konf idenzintervall und zeitlich • 
stabilen Koordinaten werden als zu ruhenden Objekten 6 
gehorig gekennzeichnet und in den Model Iparametervektor 
aufgenommen. Umgekehrt werden Punkte, die nicht oder nicht 
mehr ruhen aufgrund veranderlicher Koordinaten, aus dem 
Modellparametervektor entfernt. Analog wird die 
Fahrzeugeigenbewegung mittels robusten Schat zverf ahren aus 
den vom Radarsensor 3 vermessenen Relativgeschwindigkeiten 
aller Objekte 6 ermittelt und nur die Objekte, die sich mit 
dieser Relativgeschwindigkeit bewegen, werden als ruhend 
akzeptiert und ihre Position dem Modellparametervektor 
zugeordnet , 

Im Gegensatz zuVerf ahren aus dem Bereich des sog. aktives 
Sehens ist fur die anhand des Ausfiihrungsbei spiels 
beschriebene Erfindung somit keine gezielte Bewegung des 
Fahrzeugs 1 notwendig, sondern es wird die vorhandene 
Bewegung des Fahrzeugs 1 ermittelt und ausgenutzt, Mit Hilfe 
der oben aufges tell ten Abbildungsgleichungen (1) und (2) 
werden dann die messbaren GroSen aus der Modellwelt aus dem 
Parametervektor p nach Block 34 aus der Figur 3 ermittelt . 
Die Differenz zwischen dem Wert der messbaren GroSen 
aufgrund der Sensormessiang und der Modellierung wird als 
Fehlervektor bezeichnet (Block 35) , wobei auch der 
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Fehlervektor von den Kalibriemngsparametern abhangig ist, 
da die modellierten Werte von der Kalibrierung abhangen. 

Durch eine schon erwahnte Ausgleichsrechnung kann nun der 
Parametervektor p nach Block 36 so variiert werden, dass der 
Fehlervektor kleiner wird, z.B. durch ein Least-Square- 
Verfahren. AnschlieSend konnen neue Messungen der Sensoren 2 
und 3 hinzugefiigt werden, so dass sich insgesamt ein 
iteratives Kalibrierungsverf ahren ergibt (Block 37) . Bei der 
Durchf iihrung der beschriebenen Verf ahrensschritte stellt 
sich dabei eine relativ schnelle Konvergenz der 
Kalibrierungsparameter auf fiir eine geometrische 
Vermessungen gute Werte heraus . Besonders giinstig fiir die 
Qualitat der Kalibrierung ist dabei die Zugrundelegung der 
Rotationsbewegungen des Fahrzeugs 1, wie sie in der Praxis 
durch Nickbewegungen oder durch Kurvenf ahrten auftreten. 
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Anspriiche 

1. Verfahren zur Kalibrierung eines Sensorsystems , mit dem 
eine Erfassung und Auswertung von Objekten im 
Kursverlauf eines Fahrzeuges (1) durchgefiihrt wird, bei 
dem 

mit dem Sensorsystem (2,3,4,5) charakterist ische 
Daten der Objekte (6) erfasst werden und die Daten, 
die unter Beriicksicht igung der Eigenbewegung des 
Fahrzeugs (1) als ruhende oder quasi ruhende Objekte 
(6) erkannt werden, einer Kalibrierungseinheit (7) 
zugefiihrt werden und bei dem 

die Abweichung der aktuell gemessenen Daten von Daten 
eines Modells der Objekte (6) als Fehlervektor 
ermittelt {25;35) und zur Korrektur der Daten des 
Modells in Richtung auf eine Minimierung der 
Abweichung herangezogen wird (27 , 2 6 ; 3 6 , 37 ) . 

2. Verfahren nach Anspruch 1, dadurch gekennzeichnet , dass 

nach einer Initialisierungsphase (30) mit vorgebbaren 
Parametern eine erste Erfassung (20,21/31,32) der 
Objektdaten vorgenommen wird, die als Model Idaten 
gespeichert werden (22, -33) und dass 
in alien zyklisch darauf folgenden Messungen die 
jeweils aktuellen Objektdaten mit den zuvor erfassten 
gespeicherten Modelldaten zur Gewinnung des 



jeweiligen Fehlervektors in der Kalibrieriingseinheit 
verarbeitet werden (25 , 26 ; 34 , 35) . 

Verfahren nach Anspruch 2, dadurch gekennzeichnet , dass 
wahrend der Verarbeitung der Daten in der 
Kalibrierungseinheit (7) die jeweils in den 
vorherigen Messungen gewonnenen Objektdaten 
ausgewahlt werden, wobei nicht wieder gefundene 
Objektdaten geloscht und jeweils neu hinzugekommene 
Objektdaten auf genommen werden \ind dass 
die Objektdaten, die nach mehrmaligen Messungen aus 
unterschiedlichen Posit ionen des Fahrzeugs (1) heraus 
eine Verkleinerung des jeweiligen Konf idenzintervalls 
aufweisen, als zu einem ruhenden oder quasi ruhenden 
Objekt (6) gehorenden Daten gekennzeichnet werden. 

Verfahren nach Anspruch 2 oder . 3 , dadurch gekennzeichnet, 
dass 

aus auf einanderf olgenden Objektdaten eine 
iibereinstimmende Relat ivgeschwindigkeit von Objekten 
und daraus die Eigenbewegung des Fahrzeugs (1) 
ermittelt wird und dass 

die Objektdaten, die einem Objekt (6) mit dieser 
gleichen Relativgeschwindigkeit zuzuordnen sind, als 
zu einem ruhenden oder quasi ruhenden Objekt (6) 
gehorenden Daten gekennzeichnet werden. 

Verfahren nach einem der vorhergehenden Anspruche, 

dadurch gekennzeichnet, dass 

als Eigenbewegung des Fahrzeugs (1) eine 
Rotationsbewegung des Fahrzeuges (1) durch 
Nickbewegungen und/oder durch Kurvenf ahrten 
herangezogen wird. 
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Verfahren nach einem der vorhergehenden Anspriiche, - 

dadurch gekennzeichnet , dass 

das Sensorsystem ein Bildauf nahmesystem als Sensor 
(2) beinhaltet, bei dem mittels einer elektronischen 
Kamera mit nichtlinearer Wandlerkennlinie in den 
Auf nahmeintervallen jeweils seriell Bildpunkte 
erf ass t und ausgewertet werden. 

Verfahren nach einem der vorhergehenden Anspriiche, 

dadurch gekennzeichnet, dass 

die Ergebnisse der Kalibrierung eines Sensors (2) des 
Sensorsystems auf einen oder mehrere weitere Sensoren 
(3,4,5) am Fahrzeug (1) zur Kalibrierung auch dieser 
Sensoren iibertragen werden. 

Verfahren nach einem der vorhergehenden Anspriiche, 
dadurch gekennzeichnet, dass 

- fur den Fall, dass ein oder die Sensoren (2,3,4,5) des 
Sensorsystems widerspriichliche Messdaten erstellen, 
eine Signal isierung an eine Auswerteeinheit oder an 
den Fahrer des Fahrzeugs (1) erf olgt . 
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10 Verfahren zur Kalibrierung eines Sensorsystems 

^^^|||^ Zusammenf assung 

Es wird ein Verfahren zur Kalibrierung eines Sensorsystems 
15 vorgeschlagen, mit dem eine Erf assung und Auswertung von 

Objekten im Kursverlauf eines Fahrzeuges (1) durchgefiihrt 
wird. Bei dem Verfahren werden mit dem Sensorsystem 
(2,3,4,5) charakteristische Daten der Objekte (6) erfasst 
und die Daten, die unter Beriicksichtigung der Eigenbewegung 
2 0 des Fahrzeugs (1) als ruhende oder quasi ruhende Objekte (6) 

erkafint werden, einer Kalibrierungseinheit (7) zugefiihrt. In 
der Kalibrierungseinheit (6) werden die Abweichung der 
aktuell gemessenen Daten von Daten eines Modells der Objekte 
(6) als Fehlervektor ermittelt (25;35) und zur Korrektur der 
Daten des Modells in Richtung auf eine Minimierung der 
Abweichung herangezogen (27 , 26 ; 36 , 37) . 
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